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13.  ABSTRACT 

The  previously  developed  guidanee  law  implemented  onboard  the  Small  Unmanned  Aerial  Vehiele 
(SUAV)  relies  exelusively  on  the  information  from  the  image  proeessing  software  and  allows  to  perform 
eoordinated  SUAV  guidanee  and  vision  based  target  traeking  and  motion  estimation.  This  enables  “passive  only” 
eoordinated  traeking  of  non-eooperative  targets.  An  analysis  of  the  system  performanee  shows  that  the  developed 
target  traeking  law  demonstrates  poor  range  holding  eapability  when  the  target  performs  evasive  maneuvers. 
Therefore  a  new  guidanee  law  has  been  formulated  by  resolving  SUAV  dynamies  with  respeet  to  the  moving 
target  frame  as  oppose  to  the  inertial  frame  in  previous  formulation.  This  simple  modifieation  results  in 
theoretieally  aehievable  perfeet  range  holding  eapability  for  the  priee  of  requiring  the  target  motion  information  to 
be  known.  As  a  result,  this  new  modifieation  is  based  on  the  assumption  of  known  target  states  whieh  in  turn 
requires  an  implementation  of  a  target  motion  estimator.  An  obvious  tradeoff  in  performanee  of  the  “passive  only” 
and  “estimator  based”  target  traeking  systems  is  investigated  in  this  thesis  under  the  realistie  eonditions  ineluding 
target  loss  events. 

This  work  extends  previous  results  by  investigating  the  performanee  of  both  guidanee  laws  to  the 
variation  in  target  veloeity  and  frequeney  of  traeking  loss  events.  The  results  obtained  are  based  on  the  high 
fidelity  6DOF  simulation  implemented  in  SIMULINK,  and  analyzed  using  the  multi-eriteria  optimization 
methodology  introdueed  in  the  previous  work.  The  results  show  that  both  guidanee  laws  suffer  predietable 
degradation  in  performanee  when  subjeet  to  the  external  disturbanees  and  traeking  loss  events.  However,  in  the 
absenee  of  traeking  loss  events,  the  new  guidanee  law  suffers  less  degradation  in  performanee  as  eompared  to  the 
old  guidanee  law.  When  “frequeney”  of  traeking  loss  events  is  low  (less  than  12%),  the  new  guidanee  law  is  still 
able  to  provide  better  performanee  than  the  old  guidanee  law  As  the  “frequeney”  of  traeking  loss  events  inereases 
further  (between  12%  to  25%),  the  performanee  of  the  new  guidanee  law  starts  rapidly  degrading  eonverging  to 
that  of  the  initial  system;  as  the  target  estimator  is  no  longer  able  to  provide  a  good  predietion  of  the  target  veloeity 
and  heading  to  the  guidanee  law. _ 
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ABSTRACT 


The  previously  developed  guidance  law  implemented  onboard  the  Small  Unmanned 
Aerial  Vehicle  (SUAV)  relies  exclusively  on  the  information  from  the  image  processing 
software  and  allows  the  performance  of  coordinated  SUAV  guidance  and  vision-based  target 
tracking  and  motion  estimation.  This  enables  “passive  only”  coordinated  tracking  of  non- 
cooperative  targets.  An  analysis  of  the  system  performance  shows  that  the  developed  target 
tracking  law  demonstrates  poor  range  holding  capability  when  the  target  performs  evasive 
maneuvers.  Therefore,  a  new  guidance  law  has  been  formulated  by  resolving  SUAV 
dynamics  with  respect  to  the  moving  target  frame,  as  opposed  to  the  inertial  frame  in 
previous  formulation.  This  simple  modification  results  in  theoretically  achievable  perfect 
range  holding  capability  for  the  price  of  requiring  the  target  motion  information  to  be  known. 
As  a  result,  this  new  modification  is  based  on  the  assumption  of  known  target  states,  which  in 
turn  requires  an  implementation  of  a  target  motion  estimator.  An  obvious  tradeoff  in 
performance  of  the  “passive  only”  and  “estimator  based”  target  tracking  systems  is 
investigated  in  this  thesis  under  realistic  conditions  including  target  loss  events. 

This  work  extends  previous  results  by  investigating  the  performance  of  both  guidance 
laws  to  the  variation  in  target  velocity  and  frequency  of  tracking  loss  events.  The  results 
obtained  are  based  on  the  high  fidelity  6DOF  simulation  implemented  in  SIMULINK,  and 
analyzed  using  the  multi-criteria  optimization  methodology  introduced  in  the  previous  work. 
The  results  show  that  both  guidance  laws  suffer  predictable  degradation  in  performance  when 
subject  to  the  external  disturbances  and  tracking  loss  events.  However,  in  the  absence  of 
tracking  loss  events,  the  new  guidance  law  suffers  less  degradation  in  performance  as 
compared  to  the  old  guidance  law.  When  “frequency”  of  tracking  loss  events  is  low  (less  than 
12%),  the  new  guidance  law  is  still  able  to  provide  better  performance  than  the  old  guidance 
law  As  the  “frequency”  of  tracking  loss  events  increases  further  (between  12%  to  25%),  the 
performance  of  the  new  guidance  law  starts  rapidly  degrading,  converging  to  that  of  the 
initial  system;  the  target  estimator  is  no  longer  able  to  provide  a  good  prediction  of  the  target 
velocity  and  heading  to  the  guidance  law. 
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I.  INTRODUCTION 


A.  BACKGROUND 

Network  Centric  Warfare  (NCW)  is  the  best  term  developed  to  date  to  describe 
the  way  the  modem  military  forces  will  fight  in  the  coming  Information  Age.  It  is  defined 
as  an  information  superiority-enabled  concept  of  operations  that  generates  increased 
combat  power  by  networking  sensors,  decision  makers,  and  shooters  to  achieve  shared 
awareness,  increased  speed  of  command,  higher  tempo  of  operations,  greater  lethality, 
increased  survivability,  and  a  degree  of  self-synchronization.  Essentially,  NCW  translates 
information  superiority  into  combat  power  by  effectively  linking  knowledgeable  entitles 
in  the  battle-space  [1]. 

The  Unmanned  Aerial  Vehicle  (UAV)  plays  an  important  role  in  NCW  and  is 
increasingly  used  by  many  military  forces  around  the  world  to  perform  primarily 
Intelligence,  Surveillance  and  Reconnaissance  (ISR),  communication  relaying  and  small 
payload  delivery  missions  in  modem  day’s  battlefield.  For  instance,  the  U.S  military  had 
reported  that  an  increased  usage  in  UAVs  was  observed  in  the  wars  in  Iraq  and 

Afghanistan^.  Faced  with  the  ever  growing  demand  to  deliver  real-time  information  to 
other  entitles  in  the  battle-space,  the  UAV  operators  will  have  to  multi-task  and  work 
harder  in  order  to  effectively  control  the  UAV  and  process  key  intelligence. 

The  current  process  for  visually  tracking  a  target  with  a  pan-tilt  gimballed  camera 
mounted  on  a  UAV  requires  two  operators.  The  first  operator  is  responsible  for 
controlling  the  platform  (UAV)  while  the  second  operator  controls  the  payload 
(orientation  of  the  gimballed  camera).  In  order  to  keep  the  camera  aimed  at  the  target,  the 
two  UAV  operators  have  to  coordinate  closely  and  continuously  communicate  with  each 
other.  If  the  target  makes  an  evasive  manoeuvre  and  gets  out  of  the  gimbal  operational 
limit  or  out  of  the  camera  resolution  range,  the  payload  operator  will  need  the  UAV  pilot 
to  manoeuvre  the  platform  in  order  to  reacquire  the  target  again.  This  can  take  a 

1  Armed  Forces  International,  “US  Military’s  UAV  Missions  Increasing.”  [Accessed  November  09] 
Available:  http://www.armedforces-int.com/news/us-militarys-uav-missions-increasing.html 
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significant  amount  of  time  even  if  both  operators  are  very  well  trained.  Obviously,  a  fully 
autonomous  UAV  equipped  with  the  proper  instrumentation  and  eontrol  software  would 
help  to  alleviate  the  problem  of  human  eonstraints.  A  Visual  Based  Target  Tracking 
(VBTT)  system  that  automatically  couples  the  dual  objeetive  of  manoeuvring  the 
unmanned  aerial  platform  and  its  sensor  payload  should  significantly  support  both 
operators,  enabling  them  to  for  mode  challenging  missions  than  ever  before. 

B.  OVERVIEW  OF  RESEARCH  PROJECT 

This  thesis  is  an  ongoing  effort  within  the  Unmanned  Systems  Researeh  Group  in 
the  Naval  Postgraduate  School  (NPS)  to  develop  a  prototype  VBTT  system  for  a  SUAV, 
as  shown  in  Figure  1 . 


Figure  1.  NPS  Small  UAV  (Sig  Rascal) 


The  VBTT  system  comprises  the  modified  remotely  controlled  small  aircraft 
equipped  with  an  industrial  autopilot  and  a  miniature  pan-tilt  gimbaled  camera  using 
commercial  off  the  shelf  components  and  custom  build  control  software.  The  system 
controls  both  the  platform  and  the  gimbaled  camera  with  the  objective  to  (i)  keep  the 
operator-selected  target  in  the  eenter  of  the  video  image,  to  (ii)  eoordinate  guidance  of  the 
UAV  around  the  target,  and  to  (iii)  provide  a  real  time  estimate  of  the  target  motion 
including  its  geodetic  position,  speed  and  heading. 

Three  major  components  were  developed  and  integrated  onboard  to  create  the 
VBTT  system  [9].  The  first  component  of  the  system  includes  a  VBTT  capability  that 
uses  the  video  imagery  provided  by  the  gimbaled  eamera.  Development  of  this 
component  involves  the  design  of  a  miniaturized  gimbaled  eamera  and  a  eontroller,  and 
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integration  of  the  automated  motion  traeking  software  by  PereepiVU,  Inc  [2],  The 
development  of  the  adaptive  controller  for  the  gimbaled  camera  loop  is  presented  in 
Section  III.  The  second  component  consists  of  a  target  motion  estimator  and  the 
development  for  the  estimator  is  also  presented  in  Section  III. 

The  final  component  of  the  system  includes  the  guidance  law  for  the  SUAV.  The 
control  algorithm  is  designed  to  navigate  the  SUAV  around  the  target  while  keeping  the 
target  in  the  center  of  the  camera  frame.  The  range  estimation  error  is  at  its  minimum 
when  the  target  is  moving  in  parallel  with  the  camera  image  plane  [9]. 

C.  OBJECTIVES  AND  SCOPE  OF  WORK 

This  thesis  extends  previous  works  [2]  -  [5]  by  investigating  the  robustness  of  the 
newly  developed  control  law  in  response  to  variation  in  target  velocity  and  “frequency” 
of  tracking  loss  events.  The  results  obtained  are  to  be  based  on  the  high  fidelity  6DOF 
simulations  implemented  in  SIMULINK  and  analyzed  using  the  multi-criteria 
optimization  technique  introduced  in  previous  work  [10].  The  results  obtained  are  then 
compared  against  those  that  are  obtained  from  the  current  control  law. 
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II.  DEVELOPMENT  OF  CONTROL  LAW 


A,  COORDINATE  SYSTEMS 

Multiple  coordinate  frames  are  often  used  to  define  the  motions  or  behaviors  of 
various  objects  in  complex  dynamic  systems.  The  translational  and  rotational  kinematics 
states  (i.e.  the  positions,  velocities  and  accelerations)  of  an  object  can  be  fully  described 
in  any  frame  as  long  as  the  transformation  relationships  between  the  coordinate  frames 
are  known.  The  following  coordinate  systems  were  used  in  the  development  of  the 
control  laws  in  this  thesis  [2]  -  [10]. 

1,  Navigation  Inertia  Coordinate  Frame  (I  -  Frame) 

This  local  level  frame  assumed  a  flat  earth  model  in  the  vicinity  of  the  reference 
navigation  point;  the  Xn  -  ¥„  axes  lie  in  a  plane  tangent  to  the  reference  point  origin  on 
the  earth  ellipsoid  surface,  and  the  Zn  axis  lie  perpendicular  to  that  ellipsoid  surface.  As 
illustrated  in  Figure  2,  this  is  a  North-East-Down  (NED)  coordinate  system  and  is  also 
known  as  the  Eocal  Tangent  Plane  (ETP). 


North 


Eigure  2.  NED  Coordinate  System 
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2. 


SUAV  Body  Coordinate  Frame  (B  -  Frame) 


A  convenient  coordinate  system  for  developing  the  equations  of  motion  of  the 
SUAV  is  a  right-hand  orthogonal  system  with  its  origin  centered  at  the  aircraft’s  center  of 
gravity.  Conventionally,  the  x-axis  points  forward  along  the  longitudinal  axis  of  the 
aircraft,  the  y-axis  points  outward  towards  the  right  wing,  and  the  z-axis  points 
downward  from  the  origin  (see  Figure  3). 


Figures.  SUAV  Body  Coordinate  Frame 


3.  Gimbal  Platform  Coordinate  Frame  (G  -  Frame) 

The  gimbal  eoordinate  frame  is  a  right-hand  orthogonal  eoordinate  system  whose 
origin  is  at  the  loeation  of  the  camera  mount.  The  x-axis  of  the  gimbal  frame  points 
forward  along  the  longitudinal  axis  of  the  gimbal  platform,  the  y-axis  points  outward 
towards  the  right-hand  side,  and  the  z-axis  points  downward  from  the  origin. 

4,  Image  Plane  Coordinate  Frame  (P  -  Frame) 

The  image  plane  reference  frame  is  the  coordinate  system  used  to  describe  the 
location  of  the  target  in  the  image  plane.  It  is  a  two-dimensional  eoordinate  system  with 
the  u-axis  aligned  with  the  y-axis  of  the  camera  eoordinate  frame,  and  the  v-axis  aligned 
with  the  negative  z-axis  of  the  eamera  coordinate  frame. 
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B, 


EULER  ANGLES 


Euler  angles  are  the  elassical  means  of  representing  rotations  in  three-dimensional 
Euclidean  space.  The  triplet  of  Euler  angles  {(l),9,y/  )  relates  two  orthogonal  coordinate 
systems  having  a  common  origin  and  the  coordinate  frames  can  be  transformed  from  one 
to  the  other  through  a  series  of  rotations  defined  by  the  Euler  angles.  Conventionally, 
when  the  Euler  angles  used  to  describe  the  orientation  of  the  aircraft  body  in  relation  to 
the  inertia  coordinate  frame,  these  Euler  angles  are  known  as  roll,  pitch  and  yaw  [6]  -  [8]. 

C.  RELATIONSHIPS  BETWEEN  COORDINATE  SYSTEMS 

A  coordinate  transformation  is  a  conversion  from  one  coordinate  system  to 
another,  to  describe  the  same  space.  A  rotation  is  a  type  of  transformation  from  one 
system  of  coordinates  to  another  such  the  distance  between  any  two  points  remains 
invariant  under  the  transformation.  A  rigid  body  in  space  can  be  represented  by  a  [3  x  1] 
vector,  and  its  orientation  to  its  own  current  coordinate  frame  or  a  transformed  coordinate 
frame  can  be  uniquely  described  by  a  [3  x  3]  rotation  matrix  at  any  instant  in  time  [6]  - 

m. 


1,  Rotation  Matrices 

The  rotation  matrices  for  a  single  two-dimensional  rotation  about  each  individual 
axis  are  given  below.  The  angle  of  rotation  is  the  Euler  angle  that  corresponds  to  each 
individual  axis. 


cos(^^) 

sin(^^)  0 

RAvh 

-sin(^) 

cos(^^)  0 

0 

0  1 

cos(^)  0 

-sm(^) 

R,(0)= 

0  1 

0 

o 

1/3 

_  1 

cos(^) 

(1) 


(2) 
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1 


(3) 


0  0 

Rx{(f)-  0  cos(^zi)  sin(^zi) 

0  -sin(^/i)  cos(^zi) 

The  complete  rotation  or  transformation  of  the  coordinate  system  is  the  sequential 
combination  of  the  two  dimensional  rotations  about  each  axis.  The  sequence,  or  order  of 
the  rotation,  is  necessary  to  properly  define  the  orientation  of  the  body  and  to  preserve  the 
orthogonality  conditions  (right-hand  system  or  left-hand  system)  of  the  transformed  axes. 

2,  Coordinates  Transformation 

The  coordinate  transformation,  or  rotation  from  the  inertia  frame  to  the  camera 
frame,  can  be  obtained  via  sequential  coordinate  transformations  from  one  frame  to  the 
other  in  the  correct  logical  order,  as  shown  below: 

=  (4) 

where  fi?  =  coordinate  rotation  from  inertia  frame  to  body  frame 

=  coordinate  rotation  from  body  frame  to  gimbal  frame 

qR  =  coordinate  rotation  from  gimbal  frame  to  camera  frame 

a.  Inertial  Frame  to  Body  Frame  Transformation 

The  coordinate  transformation  from  the  inertia  frame  to  the  body  frame  is 
simply  the  product  of  the  three  individual  rotation  matrices: 

’,R  =  R,('il>,)Ry(‘0,)R^(‘w,)  (5) 

b.  Body  Frame  to  Gimbal  Frame  Transformation 

The  coordinate  transformation  from  the  body  frame  to  the  gimbal  frame 
only  involves  rotation  through  two  angles  because  the  gimbal  platform  is  a  two  axis 
coordinate  system.  As  there  is  no  rotation  along  the  x-axis  (roll  rotation),  the  gimbal  roll 
angle  is  taken  to  be  zero. 


iR^Ry(%)R,[‘Wa) 
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(6) 


c.  Gimbal  Frame  to  Camera  Frame  Transformation 

The  coordinate  transformation  between  the  gimbal  frame  and  the  camera 
frame  allows  for  compensation  of  any  misalignment  angles  that  exist  between  the 
mounting  of  the  camera  platform  with  the  gimbal  platform.  In  all  likelihood,  some  or  all 
of  the  rotation  angles  will  be  zero  because  the  axes  will  be  directly  aligned. 

o-R  =  -R4°t*d^.(°^c)^z(Vc)  (7) 

d.  Camera  Frame  to  Image  Plane  Frame  Transformation 

The  coordinate  transformation  between  the  camera  frame  and  the  image 
plane  frame  is  not  a  rotational  but  a  positional  transformation.  As  illustrated  by  Figure  4, 
the  position  of  an  object  in  the  image  plane  frame  from  a  position  in  the  camera  frame  is 
given  as  below: 


Figure  4.  Image  Plane  Reference  Frame 
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It  is  of  interest  to  note  that,  unlike  the  previous  rotational  transformations, 
the  camera  to  image  plane  transformation  is  irreversible.  This  is  due  to  the  transformation 
of  a  three-dimensional  coordinate  system  to  a  two-dimensional  coordinate  system. 


3.  Angular  Velocities  Transformation 

a.  Body  Frame  Angular  Velocities  with  Respect  to  Inertial  Frame 

The  angular  velocity  vector,  co ,  in  the  body  fixed  coordinate  system  of  the 
SUAV,  has  components  [p,  q,  r]  in  the  x,  y  and  direction  respectively.  The  resulting 
relationships  with  the  Euler  angle  rates  for  which  are  stated  as  follows: 


1 

O  O 

1 

o 

J 

+  Rx  (  Vb  ) 

1 _ _ _ _ _ _ 

0  J 

0 

r  n 

Pb 

¥.  +  0Ak 

k-¥B  sin' 

(Obi 

= 

P 

= 

¥y-^k^  k 

= 

if/g  COS''  Ob  sin''  (j)^  ±  Og  cos''  ^zig 

_®z_ 

if/g  COS^  6g  Sin^  ^g  -  0g  COS^  (j) g 

Expressing  {^b^^b^¥b^  terms  of  [Pb^^IbAb^  below,  we  observe  the 
singularity  problem  in  Equation  (10)  when  ^dg  =  ±90°  : 


¥b 

Ob 

^B 


COS 


(In  M  + 

I  ^b) 

(1b  cos(V5)-r^sin(V^) 

Pb  ±  tan  (  'Ob  )  \qB  sin  ( )  ±  cos  (  ‘(I)b  ) 


(10) 


b.  Gimbal  Frame  Angular  Velocities  with  Respect  to  Inertial  Frame 

The  angular  velocities  of  the  gimbal  frame  with  respect  to  the  inertia 
frame  are  as  shown  below.  Equation  (10)  relates  the  angular  velocity  expressed  in  the 
gimbal  platform  frame  while  Equation  (11)  describes  the  transformation  of  the  same 
angular  rate  in  the  inertia  frame. 
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Pb 

(1b 

+R,{‘ea)Rz{‘va) 

■  0  ■ 

0 

+  Ry{‘Ro) 

o 

_ 1 

Jb  \ 

WgI 

0 

Pb 

■  0  ■ 

■  0  ■ 

G  —  G  n 

((*G1  B^ 

(1b 

0 

+k{'%) 

4 

jb  j 

JPgI 

0 

(11) 


(^gi  =  gR  (^gi  =  gR 


Pg 

^G 


(12) 


c.  Camera  Frame  Angular  Velocities  with  Respect  to  Inertia  Frame 

If  the  camera  frame  is  perfectly  aligned  with  the  gimbal  frame,  there  will 
not  be  any  rotation  between  the  two  frames.  Hence,  the  angular  rates  between  the  two 
frames  will  be  the  same.  The  relationships  are  expressed  as  below: 

^CI  ~  G^  ^GI 

Since  qR  =  I , 


cOci 


a>, 


G1 


Pg 

^G 


Cl>Ci 


CO, 


G1 


(13) 


(14) 


D,  KINEMATIC  EQUATIONS  OF  SUAV-TARGET  MOTION 

A  simplified  two  dimensional  kinematics  model  is  presented  in  Figure  7.  The 
figure  depicts  the  kinematic  relationships  between  the  angles  used  to  characterize  the 
relative  motion  of  the  SUAV-Target  system.  In  order  to  simplify  the  formulation  of  the 
target  tracking  and  UAV  control  tasks  to  a  2D  plane,  it  is  assume  that  the  autopilot  is 
capable  of  maintaining  level  flight  of  the  UAV  and  the  onboard  two-axis  gimbal  is 
inertially  stabilized  [3],  [5],  [9],  [10]. 
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7  =  Navigation  Error 

£  =  Camera  LOS  Pan  Error 

X  =  LOS  Angle  in  Inertia  Erame 
=  LOS  Vector 
=  Normal  to  LOS  Vector 


¥  =  UAV  Heading  in  Inertia  Lrame 

y/^  =  Target  Heading  in  Inertia  Lrame 

y/^  =  Camera  Angle  in  UAV  Body  Lrame 

TT  =  SUAV  Ground  Speed  in  Inertia  Lrame 

g 

=  Target  Ground  Speed  in  Inertia  Speed 


Ligure  5.  Kinematics  of  SUAV  -  Target  Motion 


The  following  set  of  basic  kinematical  relations  is  derived  directly  from  the 
kinematics  of  Ligure  5.  Lirst,  it  is  observed  that; 


ri  =  y/ 


V  2y 


(15) 


Next,  projecting  the  SUAV  and  target  speed  vectors  onto  the  LOS  results  in  the 
time  derivative  of  the  horizontal  range  to  the  target; 


p^=-V^smri  +  V,sm[y/,-{y/-ri)) 


(16) 


Similarly,  projecting  the  same  vectors  onto  the  line  orthogonal  to  the  LOS 
produces  the  rotation  speed  of  the  LOS; 


T  = 


V^cost]  V,cos[y/,-{y/-T])) 


P  P 

Linally,  an  expression  for  the  tracking  error  e  is  given  by; 


(17) 


12 


s  =  ^-W-Wh 


(18) 


Substituting  Equation  17  into  time  derivatives  of  Equations  15  and  18  produces 
the  following  set  of  equations  describing  the  kinematics  of  the  tracking  problem; 


E. 


V  cosr]-V  cos{y/  -{yy 

T]  = - ^ 

P 

A  =  -^gSin;7  +  E,sin(^^^,  -{y/ -ri)) 
V^cosrj -V,cos{y/^-{y/ 


£  = 


P 


W-Wh 


(19a) 

(19b) 

(19c) 


CONTROL  LAW  DESIGN 
1.  Initial  Control  Law  Designs 

The  initial  control  law  design  of  the  VBTT  system  has  the  following  form  [2]; 
y/  =  sign  i^Bias  -  k^Tj)  (20a) 


A 


(20b) 


The  advantage  of  this  control  law  is  that  it  is  simple  to  implement  and  the 
algorithm  relies  exclusively  on  the  information  gathered  from  the  image  processing 
software.  However,  two  main  limitations  are  observed  for  this  control  law.  Eirstly,  as  a 
fixed  bias  value  is  applied  to  turn  the  SUAV  in  Equation  (20a),  this  results  in  a  slow 
converging  speed  to  any  other  desired  range  commanded,  except  to  the  desired  range  that 
corresponds  to  the  arbitrary  turning  bias  value.  Secondly,  as  the  camera  EOS  turn  rate  is 
independent  of  the  SUAV  turn  rate,  this  results  in  poor  control  of  the  camera  EOS  and  a 
large  ki  value  is  needed  to  keep  the  camera  EOS  closely  aligned  to  the  SUAV-target 
EOS. 

To  overcome  these  limitations,  the  control  law  is  then  adjusted  to  the  following 
form  [3]; 
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(21a) 


\j/  =  —  cos  7  -  k^rj 
Pd 

(21b) 

With  the  addition  of  a  k^rj  term  to  Equation  (20b),  the  camera  control  has  become 

more  efficient  as  the  eamera  turn  rate  is  now  coupled  to  the  SUAV  turn  rate.  The  turning 
bias  in  Equation  (20a)  is  replaced  with  the  dynamically  adjusted  quantity  in  Equation 
(21a),  which  varies  with  the  SUAV  ground  speed  and  the  desired  range  to  target.  Eor  a 
stationary  target,  if  the  SUAV  starts  traeking  a  target  at  a  distanee  smaller  than  the 
eommanded  range,  it  will  spiral  outwards  to  the  desired  range.  Conversely,  if  the  SUAV 
starts  traeking  a  target  at  a  distance  larger  than  the  eommanded  range,  it  will  spiral 
inwards  to  the  desired  range.  The  navigation  angle  error  rj  will  approaeh  to  zero  when 
the  SUAV  establishes  a  circular  orbit  about  a  stationary  target  at  the  desired  range. 

The  feedbaek  system  eonsisting  of  Equations  (19)  and  (21)  is  given  by; 

7  =  -Vg eos  7  -  A:j7  +  eos  (7  -y/)p  (22a) 

p^=p'^V^smri-V^sm[ri-\p)p^  (22b) 

s  =  V^p^cosr]-k2S-V^Q,os{r]-y/)p  (22c) 

,  11.  1  .  _  1 
where  - ;  p^= - p  =  p,+  — 

P  Pd  P  Pd 

This  control  law  is  currently  being  used  in  the  VBTT  system  for  the  NFS  SUAV.  Eor 
eonvenience  of  notation,  this  control  law  will  be  referred  to  as  the  “current  control  law”. 
Notice  that  the  eurrent  control  law  still  relies  exclusively  on  the  information  gathered 
from  the  image  processing  software. 

2.  New  Control  Law  Design 

Erom  Equation  (22b),  it  is  observed  that  when  the  navigation  error  7  is  driven  to 
zero,  p^  =  F,  sin(^)  p^  ^0  (unless  the  target  is  stationary).  Hence,  the  objective  of  the 
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current  control  law  to  regulate  7  to  zero  will  not  result  in  a  eonstant  p  .  This  results  in  the 
need  to  reformulate  the  eontrol  objective  and  to  eome  out  with  a  new  control  law  design 
[5], 

According  to  Equations  (19a)  and  (19b),  the  kinematics  for  7  and  p  is 
independent  of  the  eamera  LOS  pan  errors .  Thus,  in  the  design  of  the  new  control  law,  it 
is  assumed  that  s  is  in  the  visible  angle  range  to  provide  the  neeessary  visual  feedbaek. 


North 


Figure  6.  Decomposition  of  SUAV  velocity  vector 

Consider  the  deeomposition  of  the  SUAV  ground  veetor  as  shown  in  Figure  6 

[4], 

(23) 

where  F,  is  the  target  velocity  vector,  and  the  remaining  velocity  vector. 

The  following  relationships  are  then  derived; 

cos 7  =  T)  cos 7^  +Vi  cos[^^j  -{w  ~'n)\  (24a) 
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Vg  sin  7  =  F;.  sin  7^  +  FJ  sin  -  7)] 


(24b) 


where  7^  is  the  angle  between  and  . 

Substituting  Equations  (24a)  and  (24b)  into  Equations  (19a)  and  (19b),  the  system 
kinematies  ean  be  written  as: 


K 

7  = - -COST]^  +  lf/ 

(25a) 

P 

A  sin  7^ 

(25b) 

Sinee  7^  =  0  leads  to  =  0 ,  this  suggests  that  7^  =  0  ean  be  the  eontrol  objeetive. 

Assuming  that  the  target  veloeity  is  eonstant  with  eonstant  heading,  this 

eomposition  ean  be  interpreted  by  eonsidering  the  target  eoordinate  frame  (T-frame), 
whose  origin  is  fixed  on  the  target.  In  this  frame,  the  target  is  statie  and  the  SUAV  is 

flying  with  time -varying  veloeity  V^{t)  with  the  angle  7^ (t) from .  The  dynamies  for 
7^  (t)  ean  be  written  as: 

7.(0  =  -^|^cos7^(t)  +  M,(t)  (26) 

where  (t)  is  the  turn  rate  of  the  “virtual  SUAV”  with  velocity  (t) . 

To  find  the  relationship  between  (t)  and  ^(t) ,  assume  that  the  target  is  moving  with 

constant  velocity  and  heading,  and  take  derivative  of  Equation  (26).  Then,  from  classical 
mechanics: 

V^n^+U^xV^=U^xV^  (27) 

where  denotes  the  three  dimensional  angular  velocity  vector  for  the  SUAV,  is  the 
normalized  vector  in  the  direction  of  .  Since  x  is  perpendicular  to  ,  taking  the 
inner  product  of  both  sides  of  Equation  (27)  with  gives: 
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(28) 


Substituting  Equation  (28)  into  Equation  (27)  gives: 


((u,x^,).n,)n^+KxF^=u^xF^ 


Since  the  two  terms  on  the  left  hand  side  of  Equation  (29)  are  perpendicular  to  each  other,  this 
implies  that: 

(u,xf,).n,  +\urXVr'\  =\u,xV^'\ 


VX-V,xV, 


Thus,  the  kinematics  of  the  system  in  the  T-ffame  is  given  by: 
V  it) 

Pe  =  -KX'^Vr{t) 


where  m{t)  = 


\vX{t)-\vX{t)' 


V  =  V  -V 

I-  g  t 


The  new  control  objective  is  to  regulate  77^  (7)  to  0  and  thus  drive  p{t)  to  (which  is 

the  desired  range  to  target).  To  achieve  this,  the  control  law  for  implementation  on  the  SUAV 
autopilot  controller  is  as  shown  below: 


— 7^1 -M.  (0  +  77,  (t) 

^(01  Pin 


Thus,  the  feedback  system  consisting  of  Equations  (19)  and  Equation  (32)  is  given  by: 


V{t)  =  -Krir{t)  +  K{t)  - ^  cos 77^ (7) 

ypd  pp)) 


Pe{t)  =  -K[tXVr{t) 


F.  SUMMARY  OF  THE  CONTROL  LAW  DESIGNS 


Based  on  the  information  gathered  from  previous  works,  a  summary  of  the  pros 
and  eons  of  each  control  law  design  is  presented  in  Table  1. 


Current  Control  Law 

New  Control  Law 

Pros 

-  Simple  to  implement. 

-  Relies  exclusively  on  passive 
information  gathered  from  the  image 
processing  software. 

-  Perfect  range  holding  capability. 

Cons 

-  Range  holding  capability  depends 
on  the  target  motion. 

-  Requires  information  on  target 
velocity  and  heading. 

Table  1 .  Comparison  of  Control  Law  Designs 


G.  TRACKING  LOSS  EVENTS 

Due  to  space  and  computational  power  constraint,  the  image  based  tracking 
software  cannot  be  placed  onboard  the  SUAV  and  the  visual  part  of  the  control  loop  has 
to  be  closed  on  the  ground.  Hence,  a  critical  issue  that  must  be  addressed  by  the  VBTT 
algorithm  is  its  performance  in  the  presence  of  tracking  loss  events  defined  here  as  any 
event  that  causes  the  image  processing  software  to  lose  tracking  of  the  target.  From  the 
experience  gathered  from  previous  flight  tests,  this  event  occurs  primarily  due  to  the 
dynamic  change  of  lighting  conditions  and  radio  frequency  interference  in  video  and 
control  links.  The  tracking  loss  can  be  defined  as  a  binary  signal  [2]; 

,  ,  fO  out-of  frame  event  at  time  t, 

40=  (34) 

[1  camera  tracks  target  at  time  t. 

For  a  given  binary  signal  ^(0^  (r,0  denote  the  length  of  time  in  the  interval  \T,t\ 

when  5(0  =  0 .  Then,  formally, 

t 

T^{T,t)  =  ^{\-s[(jo)yio)  (35) 

r 

The  image  processing  software  will  experience  a  brief  target  loss  event  if; 


18 


T^[T,t)<T^+a[t-T), 


t>T>Q, 


(36) 


for  some  T’o  -  0  ae[0,l].  The  scalar  is  called  the  instability  bound  and  a  is 

called  the  asymptotic  instability  ratio,  a  will  provide  am  asymptotic  upper  bound  on  the 
ratio  rj(r,t)/(t-r),  as  (t-r)  ^oo. 

From  previous  work  [2],  [5],  both  control  laws  are  expected  to  suffer  predictable 
degradation  in  performance  when  tracking  loss  events  (TLE)  occur. 
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III.  IMPLEMENTATION  OF  CONTROL  LAW 


A.  FAST  ESTIMATION  OF  TARGET  MOTION 

As  seen  from  Equation  (32),  the  new  eontrol  law  requires  information  on  the 
target  veloeity  and  heading  in  order  for  it  to  generate  the  appropriate  eontrol  input  if/  for 
the  autopilot.  A  fast  estimator  ean  be  applied  to  generate  an  estimation  of  the  target 
veloeity  and  heading  [11],  The  target  motion  estimation  eonsists  of  two  steps.  Firstly,  the 
target  position  is  ealeulated  based  on  the  available  measurements.  Thereafter,  the  target 
veloeity  and  heading  is  estimated  using  the  fast  estimator. 


1.  Calculation  of  Target  Position 

The  relative  position  between  the  target  and  the  SUAV  in  the  I-frame  and  C- 

p^,Py,pA  and  /"c  =  a]  respeetively.  Thus,  the 

following  relationship  ean  be  derived; 


(37) 


1 

1 

1 

1 

1 

_ 1 

Tc 

Py 

=  bR"R 

Py 

1 

1  _ 

1 

N 

1  _ 

1 

_ 1 

where  gR  and  fi?  ean  be  obtained  using  the  Euler  angles  of  the  SUAV  and  the  pan/tilt 
angles  of  the  eamera  provided  the  onboard  IMU.  Assuming  the  eamera  follows  the  pin¬ 
hole  model. 


1 

1 

1 

s 

1 _ _ 

1 

N 

1  _ 

1 

_ 1 

(38) 


where  F  is  the  foeal  length  of  the  eamera  and  (m,v)  is  the  position  of  the  target  image  in 
the  P-frame.  Thus,  Equation  (37)  ean  be  rewritten  as; 


1 

1 

\ 

_ 1 

Tc/U 

= 

ufF 

=  bR1R 

Pcl^c 

1 

1  _  . 

vfF 

\ 

_ 1 

(39a) 
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(39b) 


1 

1 

Pcl^c 

ujF 

1 

_ 1 

vjF 

Hence,  [p^,Py^  can  be  calculated  since  all  the  terms  of  the  right  hand  side  of  Equation 

(39)  are  known.  The  target  in  the  I- frame  can  be  obtained  using  the  SUAV  position  in  the 
I-frame  given  by  the  onboard  GPS. 


target 


=  Puav+P  =  Pu. 


P. 

Py 

h 


(40) 


2,  Estimation  of  Target  Velocity  and  Heading 

Let  x{t)  =  \^p^{t),Py{t^  be  the  horizontal  component  of  p{t)  that  has  being 
calculated  in  the  previous  section.  From  Figure  4,  x(t)  satisfies  the  following 
kinematics: 


1 

• 

'--K 

1 

II 

sin^(0l 

/  \ 

+^(0 

I 

• 

_ I 

LF.iGj 

s  \  / 

COS^^(0 

_cost^,(t)J 

(41) 


Define  the  second  term  of  Equation  (41)  as: 

sinr,(') 


a{l)  =  V,{t) 


COS 


(u(0)  =  (Un 


The  estimate  of  the  target  velocity  (t)  and  heading  can  be  obtained 

through  the  following  steps: 


a.  State  Predictor 


x{t)  =  Aj{t)-V^{t) 


sm^(t) 

cos^^(t) 


+  CO 


(O’  ^(0)  =  ^o 


(42) 
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where  x(^)  =  x(^)-x(^)and  is  a  known  Hurwitz  matrix  chosen  to  satisfy  the 
performance  requirements. 

b.  Adaptive  Law 

(b{t)  =  Y  ^Vxoj{^d){t),-Px{t)^,  (u(0)  =  (Uo  (43) 

where  >  0  determines  the  adaptation  rate,  chosen  sufficiently  large  to  ensure  fast 
convergence,  P  is  the  solution  of  the  algebraic  Lyapunov  equation  AjP  +  PA^  =  -Q  for 
some  choice  of  matrix  -Q  <  0  and  Prq/(»,»)  is  the  projective  operator  which  keeps  the 
parameter  within  the  pre-defined  bound. 

c.  Low-Pass  Filter 

(U^(.s)  =  C(5)(u(.s),  (U^(0)  =  (Uo  (44a) 

=  C(.s)(u(5) ,  a>^{0)  =  d)Q  (44b) 

where  C(5)  is  a  diagonal  matrix  with  its  i*  diagonal  element  C.[s)  being  a  strictly 
proper  stable  transfer  function  with  low-pass  gain  fy  (O)  =  1  for  i  =  1,2  . 


d.  Extraction  of  V^[t)  and  from  co^{t^ 

The  target  velocity  and  heading  can  then  obtained  from  the  following 


relationships; 


V®e2  V)  J 


(45a) 


(45b) 


More  of  theoretical  details  on  the  development  of  performance  bounds  can 
be  found  in  [5]  and  [11]. 
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B. 


CONTROL  SYSTEM  ARCHITECTURE 


The  control  architecture  that  implements  the  control  law  is  presented  in  Figure  7 
[2].  It  consists  of  an  autopilot  and  a  gimbal  driven  by  the  control  inputs  \j/  and  .  The 

onboard  CCD  camera  provides  real-time  imagery  to  the  image  tracking  software.  When 
target  lock  is  engaged,  the  image  tracking  software  will  compute  the  camera  LOS  pan 
error  s .  The  onboard  GPS  and  INS  will  in  turn  provide  the  solution  for  the  navigation 
error  r] . 
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Figure  7.  Control  System  Architecture 


C.  SIMULINK  MODEL  SCHEMATIC 

The  VBTT  SIMULINK  model  schematic  for  the  current  control  law  in  Equation 
(21a)  is  presented  in  Figure  8. 


Figure  8.  VBTT  SIMULINK  Model  Schematic  for  Current  Control  Law 
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The  current  control  law  for  the  SUAV  yaw  rate  command  if/  is  being 


implemented  in  the  “CurGuid  Controller”  block  (see  Figure  9). 


Figure  9.  “CurGuid  Controller  Block”  for  Implementation  of  Current  Control  Law 


The  VBTT  SIMULINK  model  schematic  for  the  new  control  law  in  Equation  (32) 
is  presented  in  Figure  10.  Comparing  Figure  8  and  10,  the  main  difference  between  the 
two  schematics  is  that  the  VBTT  SIMULINK  model  schematic  for  the  current  control 
law  does  not  include  the  “Target  Estimator”  block,  since  the  current  control  law  relies 
exclusively  on  the  information  gathered  from  the  image  processing  software. 
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Eigure  10.  VBTT  SIMULINK  Model  Schematic  for  New  Control  Law 
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The  new  control  law  for  the  SUAV  yaw  rate  command  if/  is  being  implemented 


in  the  “CurGuid  Controller”  block  (see  Figure  1 1). 


Turn  Limiter 


Figure  1 1 .  “CurGuid  Controller  Block”  for  Implementation  of  New  Control  Law 


D.  Li  ADAPTIVE  CONTROLLER  FOR  GIMBALED  CAMERA  LOOP 

To  guarantee  the  transient  performance  of  the  gimbaled  pan  turning  and  its 
robustness  to  time-delay  due  to  image  processing  and  varying  communication  conditions, 
a  newly  developed  Li  adaptive  controller  is  applied  to  the  gimbaled  pan  control  loop 
[12],  [11],  For  simplicity  of  notation,  let  (t)  =  -ij/^  (t) .  Therefore,  Equation  (19)  can  be 
rewritten  as; 

s{t)  =  a^s[t)  +  u,^  {t)  +  as{t)  +  (7{t)  (46) 


where  <  0 ,  a  =  (t)  =  (t) , 

K  COS7f(t)-F,  cos[^/^,  (t)-(l//(t)-?f(t)) 


■(0  = 


p(0 


-l//(t) 


The  Li  adaptive  controller  consists  of  the  state  predictor,  the  adaptive  law  and  the  control 
law  given  in  the  following  steps; 


1,  State  Predictor 

s(t)  =  a^s(t)  +  u^(t)  +  d(t)s(t)  +  o-(t),  s(0)  =  Sg  (47) 
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2,  Adaptive  Law 

The  parameter  estimations  a(t)  and  o'(t)  are  governed  by  the  following 
adaptive  laws; 


a{t)  =  TVxoji^a{t),-s{t)s{t)^ ,  a(0)  =  oCf^ 

(48a) 

a-(t)  =  rPrq/’(a-(t),-f(t)),  (j(0)  =  (Jo 

(48b) 

where  r^>0  determines  the  adaptation  rate  and  s{t^  =  s{t^ .  The  projection 
operators  ensure  that  the  parameters  are  kept  within  the  predefined  bounds. 

3.  Control  Law 

The  control  signal  (f )  is  generated  through  the  feedback  of  the  following 
systems; 


j(5)  =  D(.y)r(5) 

(49a) 

Uh{s)  =  -kx{s) 

(49b) 

where  k>Q  and  is 

any  transfer  function  which  leads  to  a  strictly  proper  stable 

transfer  function; 

cw=  “<4 

^  ’  l  +  kD{s) 

(50) 

More  of  theoretical  details  on  the  development  of  performance  bounds  can 
be  found  in  [5]  and  [12], 
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III.  SIMULATION  RESULTS 


A.  SELECTION  OF  MEASURE  OF  PERFORMANCE 

The  performance  of  the  new  control  law  is  examined  for  variation  in  feedback 
control  parameter  ,  the  relative  velocity  ratio  of  the  target  and  SUAV  V,  jV^  and  the 

“frequency”  of  tracking  loss  events.  The  results  obtained  are  then  compared  to  those  that 
were  obtained  in  previous  work  for  the  current  control  law  [9]  -  [10]. 

To  evaluate  the  performance  of  the  new  control  law,  three  measures  of 
performance  (MOP),  Mi,  M2  and  M3  are  being  devised.  These  three  MOP  are  assumed  to 
be  independent  of  each  other.  The  physical  meaning  and  definition  of  each  MOP  are  as 
follows; 

The  first  MOP,  Mi  is  defined  as  inverse  of  the  ratio  of  the  captured  range  over  the 
convergence  time.  The  convergence  time  is  the  time  taken  for  the  SUAV  to  converge  to 
its  first  zero  crossing  of  ,  while  the  captured  range  is  the  radial  range  that  is  covered  by 

the  SUAV  during  the  convergence  period.  A  lower  value  for  Mi  is  desired,  as  it 
represents  a  faster  range  capturing  capability. 

The  second  MOP,  M2  is  devised  to  measure  the  time-averaged  deviation  from  the 
commanded  range.  The  deviation  from  the  commanded  range  is  only  measured  after  the 
SUAV’s  first  closest  approach.  A  lower  value  for  M2  is  desired,  as  it  represents  better 
range  holding  capability  of  the  SUAV. 

The  final  MOP,  M3  is  devised  to  measure  the  time-averaged  navigation  error.  The 
navigation  error  is  the  angle  between  the  virtual  UAV’s  ground  velocity  vector  (V^) 
and  the  normal  to  LOS  vector  and  it  is  only  measured  after  the  SUAV’s  first  closest 
approach.  As  seen  from  Equation  (33b),  regulating  to  zero  will  in  turn  drive  the  range 

to  target  to  the  desired  range.  Hence,  a  lower  value  for  M3  is  desired,  as  it  indicates  better 
range  holding  capability  of  the  SUAV. 
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B.  SENSITIVITY  ANALYSIS  OF  MOP  TO  VARIATIONS  IN  k, 

The  sensitivity  analysis  of  the  new  eontrol  law  to  variations  of  feedbaek  eontrol 
parameter  is  examined  in  a  seenario  where  the  target  is  moving  with  a  eonstant 

heading  and  the  eommanded  range  is  300m.  This  seenario  is  ehosen  as  a  baseline  model 
for  further  eomparison  with  other  target  motion  seenarios.  The  initial  eonditions  are;  (1) 
SUAV  veloeity  =  25  m/s;  (2)  Target  veloeity  =  8  m/s;  (3)  Initial  position  of  the  SUAV  is 
at  [-1000,  0,  500]  and  (4)  Initial  position  of  the  target  is  at  [0,  0,  0].  Thus,  the  initial 
horizontal  ground  range  from  the  SUV  to  target  is  700m. 


Performanee  of  and  with  Variations  to  k^ 
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kl  =  0.35 


=  0.4 


kl  =  0.7 
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Figure  12.  Variation  of  and  versus 
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The  following  observations  can  be  made  from  the  plot  as  shown  in  Figure  12; 

(a)  It  is  observed  that  Mi  increases  with  increasing  .  This  in  turn  means  that 
the  convergence  speed  is  decreasing  with  increasing  A:, .  A  higher  value  of  causes  the 
SUAV  to  incur  a  higher  overshoot.  As  a  result,  the  SUAV  will  take  a  longer  time  to 
converge  to  the  desired  range  to  target.  It  is  also  observed  M3  decreases  with  increasing 
k, .  M2  also  decreases  with  increasing  kjtill  kj  reaches  a  value  of  0.5.  Thereafter,  M2 
starts  to  increase  with  increasing  k^ . 

(b)  As  Ml,  M2  and  M3  varies  differently  with  increasing  k, ,  there  is  an 

obvious  need  to  introduced  a  new  MOP  for  the  purpose  of  finding  an  optimal  trade  off 
among  the  criteria  [10].  Therefore,  Mq  is  introduced  as  the  square  root  of  the  sum  of 
squares  of  the  three  independent  parameters: 

Mq  =  +  +  (48) 

The  parameters  are  properly  scaled  before  the  convolution;  the  discussion  is  not  a  subject 
of  this  thesis  work.  The  choice  of  the  MOP  is  motivated  by  the  fact  that  k^  can  be 

represented  by  a  point  in  a  three  dimensional  (3-D)  space  defined  by  the  three  MOP  {Mi, 
M2,  M3}.  As  the  control  objective  is  the  minimize  all  three  MOP,  this  corresponds  to  a 
search  for  a  value  of  k^  such  that  the  distance  from  the  origin  of  this  3-D  space  is 
minimized  as  graphically  shown  in  Figure  13. 
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(c)  From  Figure  12,  it  is  also  observed  that  Mo  attains  a  minimum  value  when 
is  at  a  value  of  0.4.  Thus,  A:,  is  set  to  0.4  for  the  remaining  experiments  as  it  provides 
us  with  the  optimal  performance  for  the  new  control  law. 
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Figure  14  presents  the  results  obtained  for  the  new  control  law  when  A:,  is  set  to 


0.4. 


14(a)  SUAV  &  Target  Trajectory 


Trajectory 


North,  X(m) 


14(b)  Range  Convergence,  Range  ITolding  &  Navigation  Angle  Error  Performance 
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14(c)  SUAV  Pan  &  Tilt  Errors 
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Eigure  14.  Sensitivity  Analysis  for  =  0.4  (Optimal  Case) 
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C.  SENSITIVITY  ANALYSIS  OF  MOP  TO  VARIATIONS  IN  V, 

The  sensitivity  analysis  of  the  new  eontrol  law  to  variations  in  E,  jV^  is  examined 

in  a  seenario  where  the  target  is  moving  with  a  eonstant  heading  and  the  eommanded 
range  is  300m.  The  initial  eonditions  are;  (1)  SUAV  veloeity  =  25  m/s;  (2)  Initial  position 
of  the  SUAV  is  at  [-1000,  0,  500];  (3)  Initial  position  of  the  target  is  at  [0,  0,  0]  and  (4) 
=  0.4  .  Thus,  the  initial  horizontal  ground  range  from  the  SUV  to  target  is  700m. 

Mo,  whieh  is  defined  in  the  previous  experiment,  will  be  utilized  to  aeeess  the 
sensitivity  performanee  of  the  new  eontrol  law  to  variations  in  E,  jV^  . 


Performanee  of  and  Mg  with  Variations  to 


Figure  15.  Variation  of  ^0^2  >^3  and  "^“versus  Speed  Ratio 

The  following  observations  ean  be  made  from  the  plot  as  shown  in  Figure  15; 

(a)  It  is  observed  that  Mi  inereases  with  inereasing  jV^  .  This  in  turn  means 
that  the  eonvergence  speed  is  deereasing  with  inereasing  FJ  jV^  .  As  the  target  veloeity 
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increases,  the  SUAV  takes  a  longer  time  to  eonverge  to  the  desired  range  to  target.  It  is 
also  observed  that  both  M2  and  M3  increases  with  increasing  jV^  .  In  particular,  M2 

increases  substantially  when  V^  jV^  is  at  a  value  of  0.56. 

(b)  From  Figure  15,  it  is  also  observed  that  Mo  increases  with  increasing 
.  Similar  to  M2,  Mo  inereases  substantially  when  V^jV^  is  at  a  value  of  0.56.  This 

suggests  that  the  performance  of  the  new  eontrol  law  degrades  drastically  when  the  target 
velocity  is  more  than  half  of  the  SUAV  veloeity. 

Figure  16  to  20  presents  the  detailed  results  obtained  for  the  new  control  law 
when  VjVg  is  varied  from  6/25  to  14/25  . 
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Case  1:  =6/25 


16(a)  SUAV  &  Target  Trajeetory 
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16(o)  SUAV  Pan  &  Tilt  Errors 
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16(d)  Target  Estimator  Performance 
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Figure  16.  Sensitivity  Analysis  for  V^jV^  =  6/25 
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Case  2:  =8/25 


17(a)  SUAV  &  Target  Trajectory 
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17(c)  SUAV  Pan  &  Tilt  Errors 


_Q  2  I _ ^ _ I _ ^ _ I _ ^ _ I _ ^ _ I _ ^ _ 

■  0  100  200  300  400  500  600  700  800  900  1000 


17(d)  Target  Estimator  Performance 


True  target  \elocity 


5 


0 _ ^ ^ ^ ^ ^ ^ ^ ^ ^ _ 

0  100  200  300  400  500  600  700  800  900  1000 


Eigure  17.  Sensitivity  Analysis  for  F,  jV^  =  8/25 
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Case  3:  =10/25 


18(a)  SUAV  &  Target  Trajectory 
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18(c)  SUAV  Pan  &  Tilt  Errors 
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Figure  18.  Sensitivity  Analysis  for  VjV^  =  10/25 
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Case  4:  =12/25 


19(a)  SUAV  &  Target  Trajectory 
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19(b)  Range  Convergence,  Range  Holding  &  Navigation  Angle  Error  Performance 
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19(c)  SUAV  Pan  &  Tilt  Errors 
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Sensitivity  Analysis  for  V^jV^  =  12/25 
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Eigure  19. 


Case  5:  =14/25 


20(a)  SUAV  &  Target  Trajectory 


Trajectory 


North,  X{m) 


20(b)  Range  Convergence,  Range  Holding  &  Navigation  Angle  Error  Performance 
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20(c)  SUAV  Pan  &  Tilt  Errors 


20(d)  Target  Estimator  Performance 
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Sensitivity  Analysis  for  jV^  =14/25 
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Eigure  20. 


D.  COMPARISON  OF  CONTROL  LAW’S  PERFORMANCE  WITH 
REGARDS  TO  VARIATIONS  IN  V, 

Figure  21  gives  a  comparison  of  both  control  laws  with  regards  to  variations  in 
.  For  both  control  laws,  it  is  observed  that  Mq  increases  with  increasing  VjV^  . 

Thus,  both  control  laws  deteriorates  in  performance  when  the  target  velocity  is  increased. 
Flowever,  the  new  control  law  suffers  less  degradation  in  performance  as  compared  to  the 
current  control  law.  By  regulating  7^  (t)  instead  of  ^(t)  to  0,  the  new  control  law 

performs  better  than  the  current  control  law  in  driving  the  range  to  target  to  the 
commanded  range. 


Comparison  of  Control  Laws’  Performance  With  Regards  to  Variations  in  FJ  jV^ 


Figure  21 .  Plot  of  Mo  vs  jV^  for  Current  and  New  Control  Law 


47 


E.  SENSITIVITY  ANALYSIS  OF  MOP  TO  “FREQUENCY  OF  TLE 

The  sensitivity  analysis  of  the  new  eontrol  law  to  “frequeney”  of  TLE  is 
examined  in  a  seenario  where  the  target  is  moving  with  a  eonstant  heading  and  the 
eommanded  range  is  300m.  The  initial  eonditions  are;  (1)  SUAV  veloeity  =  25  m/s;  (2) 
Target  veloeity  =  6  m/s;  (3)  Initial  position  of  the  SUAV  is  at  [-1000,  0,  500];  (4)  Initial 
position  of  the  target  is  at  [0,  0,  0]  and  (5)  =  0.4 .  Thus,  the  initial  horizontal  ground 

range  from  the  SUV  to  target  is  700m. 


Performanee  of  and  /ITq  with  Variations  to  “Frequeney”  of  TLE 


Figure  22.  Variation  of  ^nd  '^•’versus  “Frequeney”  of  TLE 
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The  following  observations  can  be  made  from  the  plot  as  shown  in  Figure  22; 

(a)  It  is  observed  that  Mi  decreases  with  increasing  “frequency”  of  TLE  till 
the  “frequency”  reaches  a  value  of  10%.  Thereafter,  Mi  starts  to  increase  with  increasing 
“frequency”  of  TLE.  It  is  also  observed  that  M3  increases  with  increasing  “frequency”  of 
TLE.  M2  also  increases  with  increasing  “frequency”  of  TLE  till  the  “frequency”  reaches  a 
value  of  15%.  Thereafter,  M2  starts  to  decrease  with  increasing  “frequency”  of  TLE. 

(b)  Erom  Eigure  22,  it  is  observed  that  Mo  increases  with  increasing 
“frequency”  of  TLE  till  the  “frequency”  reaches  a  value  of  15%.  Thereafter,  the  value  of 
Ml  starts  to  converge  to  about  1.2  even  though  the  “frequency”  of  TLE  is  increasing. 
When  TLE  occurs,  the  camera  will  not  be  able  to  provide  an  updated  target  picture  to  the 
target  estimator.  Without  the  updated  target  picture,  the  target  estimator  will  not  be  able 
to  give  a  good  prediction  of  the  target  velocity  and  heading.  As  such,  the  new  control  law 
suffers  a  predictable  degradation  in  performance  when  TLE  occurs. 

Eigure  23  to  27  presents  the  detailed  results  obtained  for  the  new  control  law 
when  “frequency”  of  TLE  is  varied  from  5%  to  25%. 
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Case  1:  “Frequency”  of  TLE  =  5% 


23(a)  SUAV  &  Target  Trajectory 


Trajectory 


North,  X(m) 


23(b)  Range  Convergence,  Range  Holding  &  Navigation  Angle  Error  Performance 
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23(c)  SUAV  Pan  &  Tilt  Errors 


23(d)  Target  Estimator  Performance 


True  target  velocity 
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Eigure  23.  Sensitivity  Analysis  for  “Erequency”  of  TEE  =  5% 
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Case  2:  “Frequency”  of  TLE  =  10% 


24(a)  SUAV  &  Target  Trajectory 


Trajectory 
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24(b)  Range  Convergence,  Range  Holding  &  Navigation  Angle  Error  Performance 
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24(c)  SUAV  Pan  &  Tilt  Errors 
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24(d)  Target  Estimator  Performance 
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Figure  24.  Sensitivity  Analysis  for  “Frequency”  of  TEE  =  10% 
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Case  3:  “Frequency”  of  TLE  =  15% 


25(a)  SUAV  &  Target  Trajectory 
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25(b)  Range  Convergence,  Range  Holding  &  Navigation  Angle  Error  Performance 
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25(c)  SUAV  Pan  &  Tilt  Errors 


25(d)  Target  Estimator  Performance 
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Eigure  25.  Sensitivity  Analysis  for  “Erequency”  of  TEE  =  15% 
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Case  4:  “Frequency”  of  TLE  =  20% 


26(a)  SUAV  &  Target  Trajectory 
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26(b)  Range  Convergence,  Range  Holding  &  Navigation  Angle  Error  Performance 
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26(c)  SUAV  Pan  &  Tilt  Errors 


26(d)  Target  Estimator  Performance 
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Sensitivity  Analysis  for  “Erequency”  of  TEE  =  20% 
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Eigure  26. 


Case  5:  “Frequency”  of  TLE  =  25% 


27(a)  SUAV  &  Target  Trajectory 


Trajectory 


27(b)  Range  Convergence,  Range  Holding  &  Navigation  Angle  Error  Performance 
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27(c)  SUAV  Pan  &  Tilt  Errors 


27(d)  Target  Estimator  Performance 
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Eigure  27.  Sensitivity  Analysis  for  “Erequency”  of  TEE  =  25% 
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F.  COMPARISON  OF  CONTROL  LAW’S  PERFORMANCE  WITH 

REGARDS  TO  VARIATIONS  IN  “FREQUENCY”  OF  TLE 

Figure  28  provides  a  comparison  of  both  control  laws  with  regards  to  variations  in 
“frequency”  of  TLE.  For  both  control  laws,  it  is  observed  that  Mo  increases  with 
increasing  “frequency”  of  TLE.  The  new  control  law  demonstrates  better  performance 
than  the  current  control  law  when  “frequency”  of  tracking  loss  events  is  low  (less  than 
12%).  Flowever,  as  “frequency”  of  tracking  loss  events  increases  (between  12%  to  25%), 
the  performance  of  the  new  control  law  degrades  more  than  that  of  the  current  control 
law,  as  the  target  estimator  is  no  longer  able  to  provide  a  good  prediction  of  the  target 
velocity  and  heading  to  the  control  law.  Beyond  a  “frequency”  of  more  than  25%,  the 
value  of  Mo  appears  to  converge  for  both  control  laws.  This  suggests  the  existence  of  a 
lower  bound  in  performance  for  both  control  laws  with  regards  to  variations  in 
“frequency”  of  TLE. 


Comparison  of  Control  Laws’  Performance  With  Regards  to  Variations  in 

“Frequency”  of  TLE 


Figure  28.  Plot  of  Mo  vs.  “Frequency”  of  TLE  for  Current  and  New  Control  Law 
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IV.  CONCLUSION  AND  RECOMMENDATIONS 


A.  CONCLUSION 

To  improve  the  range  holding  eapability  and  therefore  to  drive  to  zero,  a  new 

eontrol  objeetive  is  formulated  by  resolving  and  rj  to  the  T-frame,  whose  origin  is 

fixed  on  the  target.  As  a  result,  the  new  eontrol  law  provides  better  range  holding 
eapability  as  eompared  to  the  previously  developed  eontrol  laws.  However,  the  new 
eontrol  law  requires  information  on  target  veloeity  and  heading  information  in  order  to 
perform  eoordinated  SUAV  guidanee  and  vision  based  traeking.  This  additional 
information  is  obtained  from  the  newly  developed  target  estimator. 

The  results  obtained  from  the  utilization  of  the  new  eontrol  law  in  high  fidelity 
SIMULINK  simulation  environment  are  eneouraging  and  eomparable  to  theoretieal 
predietions.  The  results  show  that  both  eontrol  laws  suffer  predietable  degradation  in 
performanee  when  subjeet  to  the  external  disturbances  and  tracking  loss  events. 
However,  in  the  absence  of  tracking  loss  events,  the  new  control  law  suffers  less 
degradation  in  performance  as  compared  to  the  current  control  law.  When  “frequency”  of 
tracking  loss  events  is  low  (less  than  12%),  the  new  control  law  is  still  able  to  provide 
better  performance  than  the  current  control  law  As  the  “frequency”  of  tracking  loss 
events  increases  further  (between  12%  to  25%),  the  performance  of  the  new  control  law 
starts  rapidly  degrading  converging  to  that  of  the  initial  system;  as  the  target  estimator  is 
no  longer  able  to  provide  a  good  prediction  of  the  target  velocity  and  heading  to  the 
control  law. 

B,  RECOMMENDATIONS 

After  testing  the  robustness  of  the  control  laws  to  external  disturbances  in  high 
fidelity  simulation  environment,  the  next  logical  goal  will  be  to  implement  the  control 
laws  in  a  hardware-in-the-loop  (HIL)  simulation  before  the  actual  flight  test.  Although 
HIT  simulation  cannot  replace  actual  flight  testing,  it  can  help  to  reduce  the  likelihood  of 
failure  by  detecting  bugs  and  deficiencies  before  risking  the  hardware  in  actual  flight  test. 
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Moreover,  the  HIL  simulator  provides  an  ideal  training  tool  that  can  be  used  in  the  lab. 
The  HIL  simulator  had  being  setup  in  previous  work  and  the  details  on  the  HIL  setup  can 
be  found  in  Reference  9  and  10. 
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